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1. 


Introduction 


This  report  is  a portion  of  the  research  performed  under  the  | 

Guidance  and  Control  Technology  Program  on  Automatic  Tracking  Systems  for  I 

Airborne  Direct  Fire  and  Integrated  Fire  Control.  The  dynamical  systems  1 

equations  of  the  MICOM  stabilized  mirror/gimbal  tracking  system  are  ■ 

derived  in  this  report.  These  equations  are  derived  for  the  purposes 
of  (1)  analyzing  design  changes  in  the  basic  structure  and  (2)  designing 
stabilization  and  servo  control  compensations  for  improved  accuracy  in 
tracking  and  stabilizing  a target  scene  or  in  stabilizing  a laser  beam  \ 

in  a helicopter  environment. 

The  system  consists  of  an  azimuth  gimbal,  G,  mounted  in  a base 
structure,  S,  such  as  that  of  a helicopter  pod  (Figure  1).  The  platform, 

P,  is  gimbal  mounted  in  G and  rotates  in  elevation.  Mounted  on  P are 
two  rate  integrating  gyroscopes  used  for  inertially  rate  stabilizing  P 
via  feedback  to  torque  motors  mounted  on  the  gimbal  axes  of  G and  P. 

Figure  2 shows  a schematic  drawing  of  the  elevation  and  azimuth  gyros 
mounted  on  the  platform.  The  mirror,  M,  is  not  mounted  on  the  platform, 
but  is  gimbal  mounted  on  G with  axis  of  rotation  parallel  to  that  of  P.  j 

The  mirror  is  connected  to  the  stable  platform,  P,  by  a wire  belt  pulley  | 

arrangement  with  a 2 ; 1 drive  ratio . The  mirror  is  not  mounted  on  the  i 

platform  because  a stable  view  of  a fixed  scene  and  laser  team  pointing  ! 

stability  require  the  mirror  to  move  one-half  the  angle  of  pitch  of  the  ; 

gimbal,  G.  A 2: 1 drive  ratio  consisting  of  a belt  drive  and  an  aided  inertia 
drive  can  meet  this  requirement.  The  inertia  drive,  or  ; hat  is  mis- 
nomered  the  inertia  balancer,  B,  is  a gimbal  mounted  mas 5 with  axis 
parallel  to  those  of  P and  M.  The  balancer,  B,  is  constructed  with  the 
precise  moment  of  inertia  about  its  axis  for  "inertially  balancing" 
the  mirror.  When  the  base,  S,  and  the  gimbal,  G,  pitch,  the  mirror 
should  move  in  elevation  through  one-half  the  pitch  angle  so  that  the 
scene  does  not  change  when  viewing  the  image  of  the  scene  reflected 
from  the  mirror.  The  "balancer"  will  accomplish  this  in  the  absence 
of  other  forces  and  is  especially  useful  when  the  frequency  of  dis- 
turbance motion  is  greater  than  the  bandwidth  of  the  platform  stabiliza- 
tion loop.  Figure  1 shows  the  balancer,  B,  in  contact  with  tne  belt 
drive  and  only  operates  correctly  when  there  is  no  slip  between  the 
balancer  and  belt. 

The  equations  derived  herein  describe  the  motion  of  the  gimbal, 
platform,  mirror,  balancer,  and  gyros  with  the  full  nonlinear  and 
cross -coupling  terms  and  such  imperfections  as  friction,  deformation 
of  the  wire  drive,  and  spring  coupling  due  to  electrical  cables  con-  j 

nected  between  elements  of  the  system.  The  associated  feedback  and  | 

scrvo-control  electronics,  as  they  are  presently  designed,  are  given  \ 

in  transfer  function  form  in  the  summary  block  diagram  presented  in  ; 

Section  3,  J 

I 

i 
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Preceding  page  blanis 


(a)  SIOEVir^W  (b)  FRONT  VIEW 

Figure  1.  Schematic  of  rigid  body  system  elements. 


2. 


Equations  of  Motion  for  Rigid  Body  System  Elements 
a.  Analytical  Approach 


In  a system  of  rigid  body  elements  there  are  for  modeling 
purposes,  three  classifications  of  interactions  of  the  elements.  First, 
elements  of  significant  inertia  interact  with  each  other  and  all  of  their 
motion  variables  (generalized  coordinates)  are  coupled  dynamically  in 
the  dynamical  equations  of  motion.  Second,  if  seme  of  the  element’s 
inertias  are  much  larger  than  those  of  other  elements,  the  larger  iner- 
tias are  insignificantly  affected  by  the  motion  of  the  smaller  inertias 
so  that  the  dynamical  equations  of  the  larger  inertias  do  not  include  the 
effects  of  the  smaller  inertias,  i.e.,  the  generalized  coordinates  of  the 
larger  appear  in  the  equations  of  the  smaller,  but  not  vice  versa.  For 
example,  the  smaller  inertias  of  the  gyroscopes  have  an  insignificant 
effect  on  the  platform's  motion.  However,  platform  motion  significantly 
affects  the  motions  of  the.  gyroscopes.  Thus,  there  are  equations  of 
motion  for  the  platform  as  vjell  as  the  gyroscopes  but  the  coupling  is 
from  the  platform  to  the  g’Toscopes  and  not  vice  versa  except  in  the 
electrical  feedback.  Third,  in  a variation  of  the  second  classification 
is  the  case  when  the  coupling  is  one  way  and  the  larger  inertias  have 
motions  which  can  be  measured  and  prescribed  as  a fun’ tion  of  time  rather 
than  described  by  a system  of  dynamical  equati.ons.  For  example,  the  motion 
of  a helicopter  would  not  be  significantly  affected  by  the  motion  of 
the  stabilized  mirror/gimbal  tracking  system  so  that  if  we  included  the 
helicopter  in  the  dynamical  system  (i.e.,  we  determine  its  motion  from 
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Figure  2.  Rate  integrating  gyro  stabilized  platform. 


its  dynamical  equations),  the  effects  of  the  mirror  system's  motion 
would  not  be  included-  In  this  case,  however,  the  helicopter  is  not 
dynamically  modeled  to  determine  its  motion  and,  thus,  its  effect  on  the 
mirror  system,  but  has  its  motion  prescribed  from  measurement  data  to 
determine  its  motion's  effects  on  the  mirror.  In  a related  program, 
linear  and  angular  accelerometers  are  used  to  determine  helicopter 
motion  under  typical  flight  profiles  with  dummy  rigid  masses  simulating 
the  stabilized  mirror  system  attached. 

In  this  development  of  the  system's  dynamical  equations  we  use 
helicopter  motion  data  as  the  prescribed  motion  of  the  base  structure, 

S.  The  base  motion  can  be  completely  described  by  three  angles  and 
three  coordinates  of  a point  of  S as  functions  of  time.  Herein,  we 
prescribe  the  azimuth,  elevation,  and  roll  angles  4>  (t),  and 

A tt 

|*>_(t)  and  the  position  of  a base  point  x(t),  y(t),  z(t).  These  are 

calculated  from  body-fixed  accelerometers  outputs.  The  point  x,  y,  z 
of  the  base,  S,  can  be  any  point  of  the  rigid  base  structure. 
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However,  for  laboratory  tests,  we  constxruct  the  test  stand  (on  ^ich 
the  gimbal  system  is  mounted)  so  that  rotational  motion  is  simulated 
separately  from  helicopter  translational  motion.  Figure  3 is  a schematic 
of  the  base  test  stand.  This  separation  is  accomplished  by  designing 
the  test  stand  with  rotational  axes  colinear  with  the  system's  ginibal 
axes.  The  test  stand  is  mounted  with  either  the  elevation  axis  or  the 
azimuth  axis  mounted  in  bearings  in  a fixed  support  for  rotational 
motion.  A large  shaker  provides  the  prescribed  motion  through  a rigid 
linkage.  For  a linear  motion  test,  the  test  stand  is  mounted  directly 
onto  the  haker. 


The  equations  of  motion  are  derived  in  terms  of  the  prescribed 
motion  variables  <!'^,  4>g,  x,  y,  z for  this  case  in  which  rotational 

input  motion  is  separated  from  translational  input  motion. 

The  method  of  analytical  mechanics  used  in  deriving  the  equations 
of  motion  of  the  system  is  Lagrange's  formulation  of  D'Alembert's  prin- 
ciple, i.e.,  Lagrange's  Equations  ot  First  Kind,  written  as 


^ Sk  ^ a p. 

dt  " Se  ** 


(1) 


;^ere  K is  the  kinetic  energy  of  the  system,  0 is  a generalized  coor- 
dinate, § is  its  time  derivative,  and  Fg  is  the  generalized  force  of 
the  system  for  the  coordinate  0. 


This  method  is  used  since  it  is  conceptually  straightforward  and, 
most  importantly,  it  does  not  require  the  inclusion  of  conservative 
forces  of  interaction  between  system  elements  and  then  their  elimination. 
We  are  not  interested  in  determining  the  forces  of  interaction  since 
we  are  interested  in  only  the  system's  motion  under  external  distur- 
bances and  not  in  structural  limit  design. 


The  kinetic  energy  of  the  system  is  the  sum  of  the  kinetic  energy 
of  its  parts.  Thus, 


where  is  the  kinetic  energy  of  the  azimuth  gyroscope  and  is  for 

the  elevation  gyroscope.  The  kinetic  energy  of  any  single  rigid  body, 
for  example,  B,  can  be  written  as  a function  of  the  mass  of  B,  nig,  the 

angular  velocity  of  the  body  B with  respect  to  an  inertial  frame, 

B* 

the  velocity  V of  the  center  of  mass  B*  of  B in  an  inertial  frame, 
and  the  moments  and  products  of  inertia  of  B with  respect  to  B*  which 

b/b* 

are  expressed  compactly  in  the  dyadic  (or  matrix)  form  ^ . Explicitly, 
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(b)  FRONT  VIEW  MIRROR  SYSTEM/TEST  BASE. 


Ic!  TEST  STAND  LAYOUT  FOR  ELEVATION  MOTION  TEST 
Figr.re  3.  Schematic  of  base  test  stand. 
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(3) 


Kb  is 


1 B* 


. 1 B 
V + 2 w 


^B/B*  B 
T.  ' • 0) 


where  it  is  implicitly  assimied  that  the  axes  through  B*  which  define 
the  moments  and  products  of  inertia  are  parallel  to  the  right-hand  set 

g 

of  unit  vectors  in  terms  of  u is  expressed;  i.e.,  we  express 

B B,  , B,  , B,  f , s. 

u = (4) 

where  b^^,  h^,  b^  is  such  a set  of  unit  vectors.  Such  a set  of  unit 

vectors  is  sometimes  called  a basis.  Likewise,  we  can  express  a vector 
B* 

such  as  V in  terms  of  components  in  this  or  some  other  basis.  In 
this  basis 


V^*  = V^b  + v\  + V^b 

V T V2D2  T 

B*  B* 

where  ^ is  simply  the  component  of  V in  the  ^ direction. 


(5) 


The  inertia  dyadic  is  defined  by 

i-'-  -iih  *;r  k, 

i=l  j=l 

or  in  matrix  rotation 


r B. 

B, 

B,„  1 

/k\ 

1 

12 

13 

ri 

= al.k2.b3) 

h2 

"2 

®23 

.®13 

®23 

®3  . 

where,  for  a simplier  rotation,  we  have 


b/b* 

hi 

b/b* 

12 


a 


s 


etc. 


The  kinetic  energy  of  each  rigid  body  in  the  system  can  be  derived  in 
this  manner. 
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b. 


Kinematics 


The  kineir. '.tics  of  both  the  gimballed  mirror,  platform, 
and  balancer  system  and  the  gyroscopes  are  developed  in  this  section. 
Generalized  coordinates  are  selected  such  that  the  dynamical  equations 
of  motion  will  be  simple.  The  outer  gimbal  motion  is  described  in  terms 
of  angles  with  respect  to  the  base  which  has  prescribed  angular  and 
translational  motion.  The  other  elements  of  the  system  have  only 
angular  motion  with  respect  to  the  outer  gimbal  or  an  inner  gimbal. 

The  angular  velocities  of  each  rigid  body  of  the  system  and  the 
velocities  of  the  mass  centers  of  each  body  are  now  derived.  These  are 
used  in  Section  2.c.  in  determining  the  generalized  inertia  forces. 

(1)  Gimballed  Mirror,  Platform,  and  Balancer.  With  the 
base,  S,  having  prescribed  motion,  the  only  generalized  coordinates 
required  to  specify  the  motioii  of  the  system,  G,  P,  M,  and  B,  are  those 
of  the  system  relative  to  the  base.  Thus,  we  take  the  generalized 
coordinates 

0^:  angle  of  rotation  cf  G relative  to  S 

0p:  angle  of  rotation  of  P relative  to  G 

0j^:  angle  of  rotation  of  M relative  to  G 

0_;  angle  of  rotation  of  B relative  to  G 

D 

so  that  if  the  base's  motion  is  known,  the  motion  of  every  point  of 
the  system  is  also  known. 

The  system  is  designed  so  that  if  the  base  is  level  and  a TV 
camera  is  mounted  on  the  gimbal  looking  vertically  down  at  the  mirror, 
the  TV  will  see  a scene  forward  of  the  system.  Thus,  0^^  is  chosen 

to  be  measured  from  a line  at  45  degrees  from  the  vertical  so  that  under 
nominal  operation  the  angles  will  be  small.  Figure  4 defines  the  gener- 
alized coordinates  and  illustrates  the  TV  looking  forward  at  a source  of 
light. 

llie  angular  velocity  of  G in  an  inertial  frame  is 

G « , S 

« = % + « (7) 

where  is  the  angular  velocity  of  S in  an  inertial  frame. 

The  angular  velocity  of  S is  now  derived  in  terms  of  the  base 

motion  angles  relative  to  an  inertial  frame,  <J>  , <J>  , and  <)>  , and  their 

K E A 

derivatives.  The  derivation  of  the  equations  of  motion  is  simpler  if 
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For  convenience  the  same 


u is  expressed  in  components  for  g^, 

order  and  direction  of  rotation  of  the  base  is  taken  as  the  system  rela- 
tive to  the  base.  Beginning  a rotation  in  roll  of  angle  0 about  a 

vertical  earth-fixed  line  (the  earth  suffices  for  an  inertial  frame 
in  this  derivation),  let  i,  k be  an  earth-fixed  basis  with  k vertical, 
let  r^^,  £2,  r^  be  fixed  in  S and  coincide  with  i,  j^,  k before  the  0^^ 

notation,  and  let  k and  r^  be  directed  vertically  upward.  Figure  5 

illustrates  the  description  of  the  rotation  of  S relative  to  the  eairth. 
The  new  orientation  of  S is  completely  determined  by  the  orientation 
of  r^,  £2,  thus  by  Next  a rotation  in  azimuth  is  per- 
formed. Let  a^  be  a basis  fixed  in  S during  this  rotation  and 

let  £^,  £2,  £2  remain  fixed  relative  to  the  inertial  frame  defined  by 
=.i  X>  i.e.,  hold  constant.  After  this  second  finite  rotation, 

the  new  orientation  of  S is  completely  determined  by  the  orientation  of 
® thus  by  both  and  . Finally,  an  elevation  rotation 

of  is  performed,  and  let  a , a_,  a_  remain  fixed;  i.e.,  hold  <>  and 

constant,  while  e^,  e^  are  fixed  in  S during  this  rotation.  Now, 

the  orientation  of  S is  completely  determined  by  the  orientation  of 

e- , £_,  e-  and  thus  by  <>  , 4>  , and  <^  , and  every  rotation  of  S can  be 
""1.  /.  j R A 

specified  by  specifying  and  With  these  simple  rotations 

describing  the  total  rotation  of  S,  it  is  possible  to  determine  the 
IS  S 

angular  velocity  w 5 w of  S in  an  inertial  frame,  I,  from  simple 
angular  velocities.  Observing  from  Figure  5 that 


IS  AS.RA.IR  1 ,* 

u)=(j  + a)  + (i)  = <?_e,  + 0.a„  + <)>„r„ 
— — — — E— 1 A— 3 R— 2 


(8) 


A S 

where,  for  example,  u is  the  angular  velocity  of  the  S frame  (whose 
orientation  is  determined  by  e^^,  e^)  relative  to  the  A frame 

(determined  by  a^,  a^,  a^).  Equation  (8)  is  an  expression  for  but 

is  not  convenient  to  use  until  it  is  expressed  in  a common  basis.  For 
this  purpose.  Figure  5 expresses 


% = "e^2  ''e% 


£2  = "a%  + ^A% 


^2  = ^£^2  - Sge3 


(9) 

(10) 

(11) 

(12) 
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(b)  AZIMUTH  ROTATION  OF  BASE,  S,  AND  ORIENTATION  OF  A BASE-FIXED  BASIS  a,, 32,  §3 


(c)  ELEVATION  ROTATION  OF  BASE.  S.  AND  ORIENTATION  OF  THE  FINAL  BASE-FIXED 
BASiS£,<|,  £2'"3 

Figure  5.  Unit  vectors  and  angles  for  describing  the  orientation 
of  the  base,  S,  in  an  inertial  frame,  I. 
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where,  for  example,  = sin  <>g  and  = cos  Now  substitute 

Equations  (11)  and  (12)  into  Equation  (10)  and  substitute  this  result 
with  Equation  (9)  into  Equation  (8).  Tliis  gives 

^ + ( We  + Ve>£2  + - Wa>%  • 


Since  e^  = ®x  ~ -2  ~ ®(^1  ^#2’  possible 

to  substitute  Equation  (13)  into  Equation  (7)  to  obtain  in  the  , 
S3  basis  as 

2®  = (“Sj<=G  “s/g)%  + (“s/g  - “Sj=g)%  + (®G  + %)% 

G G G 

= + o)2£2  + “3%  (1^) 

where  we  define 

\ “ *E  Va 

“Sj  = We 

“s,  ' Ve  - \Va  • «5) 


Since 


M IM  GM.IG  A ,IG 
U = U = W + W=  + u 


P IP  GP.IG  A ,IG 
u = u = w+  u=  ®pE-j^  + u 


B IB  GB^IG  A _,IG 
u = w=  w+  u=  + w 


M P 

it  is  possible  to  determine  « and  w in  their  respective  bases  by 

I G B 

expressing  u in  these  bases.  There  is  no  need  to  express  u in  the 

“1*  —2’  —3  since  the  "balancer"  B is  symmetrically  constructed 

about  its  axis  of  rotation  and  its  inertia  properties  do  not  vary  with 
respect  to  the  basis  with  rotations  of  B.  Thus,  since 


(19) 


% = CpE2  - SpE3  = + s^3 

% = SpE2  + CpE3  = 


where  a = 45  deg  - 6^^,  and  Equation  (16)  can  now  be  TOitten  in  the 
!E2»  S3  basis  and  Equation  (17)  in  the  £^,  £3  basis.  Substitution 
of  Equations  (19)  into  Equation  (16)  gives 

= (®M  ‘4)  {^a4  - ^a4)  ^2  ("a“2  + a^s)  % 


M ^ M M 

H ‘*>1  Si  + ‘*>2  S2  •*■  “3  5^3 


Similarly,  Equations  (17)  and  (18)  become 


(20) 


J±  = (sp  + 4)  % (v2  * y4)  E2  (s“3  ■ "p“2)  % 


s “1  % + «2  £2  "3  % 


(21) 


u = 


(-®B  “1)  % * 4 h*  “3  % 


B a.  B ^ B 

“i  % " “2  % “3  % 


(22) 


In  the  beginning  of  Section  2.b.,  it  was  mentioned  that  the  system 
is  designed  so  that  the  mirror  will  have  an  orientation  of  45  degrees 
viith  respect  to  the  gimbal.  With  no  torque  motor  power  and  no  distur- 
bances, the  mirror-platform-wire  drive  is  statistically  balanced  to 
seek  a 45 -degree  orientation  from  vertical . Tliis  is  accomplished  by 
having  the  mass  centers  of  M,  say  M*,  and  P,  say  P*,  displaced  from 
the  axes  of  rotation  of  M an<d  P.  Let  m be  the  position  vector  of  M* 
from  the  center  of  rotation  of  M,  say  Likewise,  let  £ be  the  posi- 

tion vector  from  P to  P*.  It  has  been  observed  that 
o 


m — m m2 


(23) 


£ = -P  £2 

where  m and  P are  the  scalar  distances. 


(24) 
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Figure  6 gives  the  geometry  of  centers  of  rotation,  centers  of 
masses  and  vectors  between  these.  These  are  now  used  to  compute  the 
velocities  of  mass  centers.  If  and  are  two  points  of  the  same 
rigid  body,  B,  then 

P P P /P 

v^ere  £ is  the  vector  from  P^  to  P^.  Thus,  it  is  possible  to  write 


* o M 

V + w X m 


(25) 


where 


M G _ 

V°  = V°  + '/xm 


and 


P*  o P 
Vf  = V + X £ 


(26) 


where 


P G _ 

V°  = v°  + u®X£^ 


Previously,  x,  y,  and  z were  allowed  to  be  any  point  of  S for  prescribing 
its  motion.  Taking  that  point  to  be  the  point  which  is  common  to  S 

and  G and  fixed  in  both.  Thus, 

G 


V = V.  e^  -t-  + V3  £3  = £3 


(27) 


wherein  Vj^,  V^,  V3  are  computed  from  base-fixed  accelerometer  data. 
The  vectors  m^  and  £^  can  be  expressed  as 


So  = £2  + "'3  % 

^ ~ ^2  % ^ ^3  % 

so  that 

/ X - m3U^  £3  + £3  (28) 
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Figure  6.  Centers  of  rotation,  centers  of  masses, 
and  their  position  vectors. 


G 

0)  X 


(P3W2  - ?2«3^  % - ^3“^  £2  ^2'^!  % • 

From  Equations  (20)  and  (23)  the  following  is  derived: 

M V,  M \ r M M / . J 

u)  X ra  = -m[u3  = -m  + c^g^)  . 


(29) 


Likewise,  Equations  (21)  and  (24)  give 


P / P P \ 

W X D = P (CO^  £3  - £3  j . 


(30) 


(31) 


M*  P* 

At  this  point  V and  V can  be  expressed  in  terms  of  the  generalized 
coordinates,  their  rates,  the  prescribed  motion  <i>g,  <1'^, 

^1’  ^2’  ^3  ^ common  basis.  The  basis  g^,  g^,  g^  is  a convenient 

basis.  On  substituting  Equations  (27),  (28),  and  (30)  into  Equation 
(25)  the  result  is 


M*  / 

i 


G 

G 

+ 

m_u„ 

- ‘ 

3 2 

2 3 

G 

. ^ M 

+ 

m„c<3. 

+ mC^w, 

2 1 

a 1 

M 

mw. 


)%  + (' 


■ "3"l 


M\ 

‘a“lj 


(32) 
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i 

I 

I 

i 


Similarly,  from  Equations  (26),  (27),  (29),  and  (31) 

‘ + ^2  - V3  * >^3)  Si 

(\  - V?  + f=p“l)  K2 

+ + P2»“  - P Sj  (33) 

is  obtained.  Likewise,  for  V similar  terms  are  obtained  but  with  ^2 

and  instead  of,  say,  'P^  aiid  with  P = 0.  Since  B*  coincides 

with  B , 
o’ 


b 

— o 


■^(\-'>3“?)s2+(''3-^Vl)s3  • 


(2)  Kinematics  of  Gyroscopes.  The  gyroscopes  are  mounted 
on  the  platform,  P.  One  gyroscope  has  its  sensitive  axis  parallel  to 
the  axis  of  the  gimbal,  G,  to  sense  azimuth  rates.  The  other  gyroscope 
has  its  sensitive  axis  parallel  to  the  axis  of  the  platform,  P,  to  sense 
elevation  rates,  A schematic  of  each  gyroscope  is  shown  in  Figure  7. 

The  gyroscopes  are  single  degree-of-freedom  rate  integrating  gyros  with 
their  gimbals  mounted  on  the  platform,  P.  The  gyro’s  rotor  i=l,  2, 

is  motor  driven  at  a constant  rate  u)  with  respect  to  the  gyro  gimbal  C^. 

Tlie  rotor  is  symmetric  about  its  axis  of  rotation  so  that  all  lines 
through  the  mass  center,  RJ,  and  perpendicular  to  the  rotation  axis  are 

principal  axes  for  R?.  The  center  of  mass  of  C|,  coincides  with  R^. 

The  generalized  coordinates  of  the  single  degree-of-freedom  gyros  in  an 
inertial  frame  are  i=l,  2,  and  the  coordinates  of  the  platform,  P. 

The  angular  velocity  of  the  rotor  R^  is 


Ri 

00  — CO  *•  w C , 

““  — iZ 


(35) 
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if 


S3 

/ 

Si 

(a)  GENERALIZED  CXKJRDINATES  AND  VECTOR  BASES  FOR  THE  AZIMUTH  GYRO. 


lb)  GENERALIZEDCOORDINATES  AND  VECTOR  BASES  FOR  THE  ELEVATION  GYRO. 

Figure  7,  Schematics  of  azimuth  and  elevation  gyroscopes 
mounted  on  platform. 


(36) 


The  gyro  gimbals  have  angular  velocities 

*^1  p 

“ -2 


2 P * 

« +^2^23 


(37) 


Previously,  u was  determined  in  the  2.^,  £2*  £3  t>asis.  From  Equation 
(21)  the  following  is  obtained  in  the  Q.^2*  %3 


P Pp  . 


'•1-11 

Likewise,  in  the  £32*  —23 


- 4pJ%2  if2\ 


J = JS21  (“2%  - VpJ  £22  + “3  £23-  ('»> 

Finally,  note  that  the  velocities  of  the  mass  centers  R*  and  C|  do 


not  depend  on  and  p^. 


c.  Inertia  Forces 


D'Alembert's  principle  states  that  a reference  frame 
exists  such  that  the  system’s  active  forces  with  the  inertia  forces  in 
the  frame  are  a zero  force  system.  This  frame  is  called  an  inertial 
frame.  If  certain  forces  of  interaction  within  the  rigid-body  system 
are  not  to  be  detemined,  then  the  use  of  D'Alembert's  principle  is 
worthwhile  since  standard  operations  on  zero  force  systems  in  statics 
allow  one  to  equate  moments  about  any  point  to  zero.  (We  take  moments 
about  points  on  lines  of  action  of  forces  that  we  wish  to  eliminate 
from  the  dynamical  equations  and  thereby  reduce  the  number  of  unimpor- 
tant variables.) 

Lagranre's  formulation  of  D'Alembert's  principle  allows  one  to 
elinrinate  all  unnecessary  forces  of  interaction  directly  without  using 
time-consuming  algebraic  elimination  methods. 

(1)  Lagrange's  Form  of  Inertia  Forces  for  Gimballed 
Mirror  System.  In  this  section,  we  shall  deal  with  only  inertia  forces 
which  are  derived  only  from  properties  of  the  system's  elements  and 
kinematics . Tlie  generalized  inertia  forces  of  Lagrange  are  given  by 


d Sk 


(40) 
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where  0 reprasentts  each  of  the  generalized  coordinates.  To  determine  the 
generalized  inertia  forces  in  terms  of  the  generalized  coordinates, 
their  derivatives,  and  the  prescribed  motion  it  is  necessary  to  deter- 
mine Sk/30„,  5k/S0  , ^K/i30p,  etc.  where  K is  given  by  Equations  (2)  and 
(3).  n M r 


If  the  basis  for  each  body  of  the  system  has  unit  vectors  parallel 
to  principal  axes  of  inertia  of  the  body  for  its  mass  center,  then  the 
products  of  inertia  in  Equation  (6)  are  zero.  The  system  is  designed 
so  that  an  axis  of  rotation  of  an  element  is  precisely  parallel  to  a 
principal  axis  of  the  body  for  its  mass  center.  Thus,  the  kinetic 
energy  of  each  body  can  be  ^nritten  as 


(41) 


since  the  product?  of  inertia,  ®23*  zero.  We  now  take 

the  partial  derivatives  of  the  total  kinetic  energy  [Equation  (2)]  with 
respect  to  the  generalized  coordinates.  Since  some  of  the  velocity  and 
angular  velocity  components  are  not  functions  of  all  of  the  generalized 
coordinates,  we  have 


I 

L i=l 


B*  ^ V B ^ 
(Vj  ) + I B.(co“) 

i=l 


i=l 


i=l 

3 3 

..B'^  , V'  « B B 


M 


Vj,-  Vj"  + I B,  0,. 

• 1 ^ 


i=l 

3 


i=l 


p .p 


i=l 


" i=l 


(42) 


(43) 


+ ^Kjj/S0p  + ays0j 


(44) 


3 3 

hK/^e.  = m.  X vf  V?*  + y G.  CO?  _ 

' G G ^ i x,0_  4/  X 1 1,0 


i=l 

3 


i=l 

3 


, V , V w MM 

+ "m  I ''l  + I »i  “i  “i, 


M M 


i=l 


i=l 
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3 3 

. V B*  B*  v'  B R 

^ "b  ^ ''i  ^ ®i  “i  “i,< 


V-  P*  P*  «-«  t*  F 

+ y V.  V.  . + z P4  “4  . 

P ^ 1 1,0  ^ i i 1,6 


Terms  in  Equations  (44)  and  (45),  such  as  oKg/S0p  and  Bk^/S0^,  are 

due  to  the  elevation  and  azimuth  gyroscopes.  They  are  insignificant 
compared  to  the  other  terms  and  will  not  be  included  until  the  gyro- 
scopes' inertia  forces  are  derived  in  Section  2.c.(2).  The  task  now 
is  to  express  the  terms  in  the  summations  as  functions  of  the  general- 
ized coordinates.  From  Equation  (32),  the  following  is  derived; 


M*  / G G \ M 


“ -m  C„ 


■”  '=0  “1 


(®M  + “l)“ 


A G\  M 

i(*’m  + "1  j = ■"  =a  “1 


'^1,8  " '"2^G  ■ ''l®G  "3"2,0  ■ " “2,8. 

O Cj  G 


- <'»3  - 


''2,0^  ■''2^0  ■ ''I'^G  ■ "3“i,e_  "'®a  “i,e„ 

G G G 


= - (m3  - ms^)  a>2 


^3,0  “ ^^^0:  "’2^  “i,e  ^"^2  '^1 

G G 
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The  partial  differentiation  of  components  of  Equation  (14)  with  respect 
to  d results  in 


-N 


“l.e,  = “s,  - “s,  = 4 

G Z 1 


tor . = 0 


‘A  } 


J 


(48) 


Differentiation  of  Equation  (20)  gives 


“i  e " ° 


M G ^ ^ G mV 

= ^a“2  = “3  / 


M _ G „ G _ M 

" ^a“2  " 

M 


M G _ G 

“l.S,  ' “1,9,  " “2 


M ^ G ^ G 

“2.9,  " ‘^a“2,9,  = -"a” 


J 


M G G 

"®a“l  ^ 


(49) 


(50) 


From  Equation  (21),  the  following  is  obtained; 


fl  = 0 

l,0p 

“Lop  = S ‘"a  - "P  “2  = '^3 
4,6^  = "®P  “3  “ ^P  = "'"2 


(51) 
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(52) 


P _ G _ G 

“2 

“2,0.  ""  S ‘^2,0-  " "^p“l 

G G 

^“2,0^  " ®p“l  ^ 


Differentiation  of  Equation  (22)  gives 


B _ B _ B 


10  0 0 3 0 

B B ’ B 


B G C 

‘^l,0g  “l,0j.  " “2 

B _ G _ G 

“2,0^  “2,0^  “‘^1 


A 


J 


(53) 


(54) 


The  differentiation  of  the  components  of  Equation  (32)  with  respect  to 


0 and  Q„  results  in 

r G 


Mp ' * <=A)  “ "! 

2!^ ' 

Mp  = K"f  "iK  ' " "p“l 


(55) 


p* 


G 


'’l,0p  = ''2'^c  - + <‘'3  - '■'p>“2.ep  = ’g,  - '^3  - 

G G ^ 


AA  ’ ''x‘=G  - ''2=G  - <‘■3  - “ ■''g, 

G G JL 

''3I  " <■’2  - = ('’2  - ‘^P>“2 

G G 


(P3  - PSp)w2 


} . (56) 


23 


Similarly,  Equation  (39)  gives 


= V®*  = = 0 

^1,03  ^2,^3  ^3,^3 


(57) 


= '^2^0  - ^i^G  "^3  \e. 


= \ - ^3“I 

"^2®G  ■*  ^l^G  " ^3“l,0^ 


= - b3U3- 

„B*  _ , G _ , G 

'^3,0-  ^2  1,0_  ^2“2 

o G 


(58) 


J 


Tne  substitution  of  Equations  (32) , (46) , (20) , and  (49)  into 
Equation  (42)  results  in 


8k  _ 

gg  . m^  m 
M 


"'3“2  ■ "2"3  - ""s)"” 

- (''g^  - ”3“l)  '=«“!  ■"  '"2“l)vi_ 


+ (M^  - M3)  (0^  (O3 


(59) 


From  Equation  (43)  with  Equations  (22) , (58) , (34) , and  (57) , the 
following  is  obtained: 


From  Equation  (44)  with  Enuations  (21),  (56),  (33),  and  (55)  ana  with 
oK^/o9p  = ~ 0,  the  following  is  obtained; 


+ 


p\  I 

3y“2 

- (%  - V^)s“i  - ■ V?)  =p“i 


^'-”p^  (\ 


+ (Pj  - Pj)  U.P 


C'l) 


With  oKg/30g  = 3K^/o6g  = 0,  the  substitution  of  Equations  (14),  (48), 

(32),  (47),  (20),  (50),  (34),  (38),  (22),  (54),  (33),  (56),  (21),  and 
(52)  into  Equation  (45)  results  in 


3k 


^=”'0^2 


J + (Gj  - ap  4 


+ (m^  + ms^) 


] 


+ |(m2  + mC^)  jio^  V3  + mC^0^  + to^(m2  + mC^) 

- 4(\  - 4 ^"*3  ' "'^a>)]+ 

^ ^^2  " '"^3^  S:^a“3“l  ^ (^1  " ^2^0  " ^3®a)  “l 

_^2'-'2  h “ ^2‘"3  \ (^2^4  ^3“2)  " ®1®b“2  ’ h>44 

(Fz  - PCp)  [4(v^  - PCp0p  + .[(Fz  - PC,)) 

2 - 4 (^3  - ^^P>)]  “ "P^’^P  [^G,  ^"3  - 

+ Pl^p'"2  ■*■  <^^3  ” ^2^  ^P®p“3‘^l  (^1  ~ ^2^P  " ^3®p)“i^2 


+ m. 


(62) 


It  is  necessary  next  to  determine  the  partial  derivatives  of  the 
system’s  kinetic  energy  with  respect  to  the  derivatives  of  the  general- 
ized coordinates.  Since  some  of  tbe  velocity  and  angular  velocity  com- 
ponents are  not  functions  of  all  of  the  generalized  coordinate  rates, 
we  obtain  only  the  following  terms: 


K 


3 3 

M*  „M* 


“ "Vi  P 'i  'i.e„  P "i  “i  “i.e 


(63) 


i=l 


i=l 


m 
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3 


3 


X vf*  vf**  + y P.  uf  uf  ; + K.  i + IC  • (64) 

P P ^ 3.  1,0  ^11  i,u  A,0  'E,0 


" i=l 


K.5,  = I 

i=l 


K,0  V.  V.  1 + X M-  W- 

* G ^ 1 1,0  ^ 1 1 1,0 


^ i=l 


ZP*  P*  r'  f Jb" 

V-  v:  * + y p.  uf  to.  • 
1 1,0  ■^11  1,0 


« i=l 


Z„B*  ,,B*.  . V „ « B 

V.  V.  A + X B.  'j).  «.  t 

1 1,0  ^11  1,0 


« i=l 


V -,G*  ,,G*.  . V ^ G G 

X V.  A + X G.  w.  to,  i 
^ 1 1,0  1 1 1,0 


" i=l 


+ K 5 + 5 • ^66) 

(Again  we  neglect  the  gyroscopes’  inertia  terms  such  as  K • and  K_  • ,) 

A, Op 

We  now  express  Equations  (63)  through  (66)  in  terms  of  the  generalized 
coordinates  and  their  derivatives.  From  Equation  (14)  we  observe  that 


4 0 " 4 0 ^ ^ 

’ G ’ G 


\J  ^ 


From  Equations  (20)  through  (22)  we  obtain 


“i  0 = 1 

M 

M _ M _ _ 
"2,6^  - "3,0^  - 
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Similarly,  Equations  (32)  through  (34)  give 


28 


V®*-  =-b 


B* 

= » 
V®*-  =0 


(79) 


The  substitution  of  Equations  (32),  (74),  (20),  and  (68)  into 
Equation  (63)  results  in 


+ (Va  - ”'3®a>  “l  “ “l]  “i 


(80) 


From  Equations  (21),  (33),  (64),  (69),  and  (75),  we  obtain 
K,«J,  = Bp  p[sj,  - CpV3  - (P3SJ  + 


+ P 


[^p''c 

p1  p 

“ij  '■l  “1 


From  Equations  (22),  (34),  (65),  and  (70),  we  obtain 

# ^ 

K,6g  - cOj^  . 


(81) 


(82) 


Substitution  of  Equations  (14),  (20),  (21),  (22),  (32),  (33),  (34),  (67), 
(71),  (72),  (73),  (76),  (77),  (78),  and  (79)  into  Equation  (66)  results 
in 


*^3^3  \®2  (®2“3  ■*  ^3^2  " ^G 


x)"V‘ 


(Vp  ^2=p)“3 

+ («3‘=a  + “2^ 

+ [mp(PCp  - P^)  - mgb^  - m^(m2  + mC^)i 

+ (m^  + mC^)  + m^U)^  - 


+ (P^  - P3)SpC^u,^ 


W3  + (M3  - M2)s^Cq,u‘2 


+ m2U)3  - m3. 

+ m„  (P^  - PC^)  ( Pw^  + P2W3  - P, 


P '-2 

+ V2 


{' 

(‘'2“3  - 


(83) 
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We  now  take  the  time  derivatives  of  Equations  (80)  through  (83). 
They  are  required  in  the  generalized  inertia  forces  given  by  Equation 
(40).  These  derivatives  are 


+ "m  "[=a''3  ■ Vgj  (Va  + ”3<=a>“?]®H 


(84) 


_d, 

dt 


K.6p  = (p,  + v')“l  - "■[v'3  - ^p\  * ('■: 

pp^’3  + ' 


2S 


+ mp  P 


^ = -h 


S "-“g  = (<= 


■*■  VZ  ' ®3"’' 


^ \) 


•G 


‘3  “2^  " 2 


- '"g  (y  ^ ®p  "Vi  "a  ^m) 


VI 

*v 

I 

o 

1 1 

• 

«3^ 

i *G 

|u>3 

(M3  - M2)  ^Qpa.y^ii 

1 

P3)  ^Cp  - Sj 

'■.)4K 

«3>  {i  - i)  “2®« 

2 ■*■  "Vi  ^"'z 

mC^)] 

+ (m2  + mc^) 


( -M 


•G  -G 

+ m2U)3  - m3U2 


+ ™M  ®a  ry  ■*■  ™2'^3 


M 


’il 


(85) 


(86) 
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(87) 


4-mp  (P^-PCp  (^ra,3  + P^co^.. 

+ "P  " «P  (^  V3  - V2) 

+ njb^  (>>2“3  - '’3“2) 

The  generalized  inertia  forces  can  now  be  written  in  equation  form. 

The  combination  of  Equations  (59)  and  (84)  as  in  Equation  (40) 
results  in 

\ " («2  - «3  - V)  “2  “3  V [(\  "3"2  - V3)  “2 

- (\  - ”3“?)  <=a“l  (''3  "2"l)  %“l] 


L . 2\  *M  r * . 

(«1  + -V"  j “1  - V [V3  ‘a\ 

(«2Co  - 

("2®a  + “3V  “ij  • 

(88) 

Equations  (61)  and  (85)  are  substituted  into  Equation  (40).  The  result 
is 


The  generalized  inertia  force  for  0 obtained  from  Equations  (40) , (60) , 
and  (86)  is  ® 

F*  = B.u®  . (90) 

Similarly,  from  Equations  (40),  (62),  and  (87)  we  obtain 

\ “ [=1  - S V2  "mS  - Va  - 

+ - PCp)2  + - PjS^J  0,®  0,f 

"*B^2^3  ®P^^2  " ^^^3  “ ^ "'g^2®3 

+ (?3  - P^)  Cp.p)  Jl 

+ [m^  ni(C^m2  + s^m^  + m)  + M^]  0^  - % 

+ [mp  P(P  - CpP^  - SpP3)  + P^]  0)2 
+ V^co^  [m^g2  + mj^j(m2  + mC^)  + mgb2 

+ i.ip(P2  - PCp)]  - [m^(m2  + mC^)  + mgb2  + m^g2 

+ mp(P2  - PCp)]  + m s„  - rUp  P Sp  0p^ 

- [S  "■  "3  -*■  ¥p  "2^P  ^4 

+ \4  ^ "Vl("'2  ■*■  '"2  + "'p^‘2  " ^2 

+ ">2^2^  0)3  + [i"q8283  ■*■  (P3  •*  ^2^  ®P^P 

+ (M2  - M3)  (^2  "’3 

* G 

+ mp(P2  - PCp)  P3  + ni3b2b3]  u)^ 
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• ' Vz  ■ ”P^^2  ■ V Vz  “ii<”z  ”'=a» 

■ ”m^”z  '''  “'it'  “ “3  - I»p(*'2  ■ ^ "3 

+ [z(Pj  - Pj)  SpCpSp  + ZCMj  - M3)  s„C„S„ 

" “ ®a  “2  “ “p  ^ ®p  ^2  ®pj  “3 

+ [(P3  - Pj)  (cj  - sfj  9p  + (M3  - Mp  (c^  - 4) 

+ By  m m3  + mj  P Sp  P3  P^J 

^ "p  ^ "m  ” - ”“3)^  • <«« 

(2)  Lagrange *s  Form  of  Inertia  Forces  for  Gyroscopes. 
Here,  as  in  the  last  section  for  the  gimballed  mirror  system,  we  derive 
the  generalized  inertia  forces  of  Lagrange  for  the  gyroscopes.  For 
any  system  of  rigid  bodies,  the  Lagrange  generalized  forces  are 
expressed  as  in  Equation  (40).  The  kinetic  energy  of  each  rigid  body 
element  of  the  gyro  can  be  expressed  as  in  Equation  (41) . 

Since  the  velocities  of  the  mass  centers  of  R.  and  C.  do  not 
. 1 i 

depend  on  and  p^,  there  is  no  need  to  include  the  translational 

velocity  terms  in  the  kinetic  energy.  Thus,  we  simply  write  the  kinetic 
energies  of  the  systems  as 

K = K + K-  (azimuth  gyro)  (92) 

A 

Kj,  = (elevation  gyro)  (93) 

where 


and  i=l,2,  j=l,2,3,  are  principal  moments  of  inertia  of  R^^ 

and  C.  for  their  mass  centers. 

1 
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We  now  determine  the  gensralized  inertia  forces  as  expressed  by 
Equation  (40)  for  the  gyroscopes.  The  gyroscope's  Equation  (40)  is 
written  as 


- dT  35;; 


(94) 


P'5 


(95) 


The  derivatives  in  Equations  (94)  and  (95)  are  to  be  expressed  in 
terms  of  the  generalized  coordinates,  their  rates,  and  the  prescribed 
motion  of  the  system's  base  mount.  From  Equations  (92)  and  (93)  we  have 


5p7  ” ^ (“ii  “1  “i.p,  '11  “1  “i,P.  ) 

i=l  ^ ^ ' 


(96) 


5^  = I (®2l  “1  “l,P,  Si  “i  “1 

^ i=l 


■^0 


(97) 


hK.  ^ / R,  Ri  C,  \ 

^ = 1 [ht  \ **•  ^li  “i  Xh^ ) 

^ i=l  ^ 


(98) 


^ / R R C C y, 

^ - I (^2i  ‘^i  “i,L  ^2i  '■’i  ^iyL  ) 


C„  C, 


i=l 


wherein  from  Equations  (35)  through  (39)  we  find 

\ h 

to/-  = W.  R =0 


- " (fl  "(3.  + 


Pp  P 
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g..- 


^2  ^2  P P 

“l,?2  “ “l,?2  ~ ^^2^2  " “l®^2 


^^2  ^2  / P P \ 

“2,^2  = “2,^2  = “ (“*2  ^1^2) 


^2  ^2 

P ==  S r = 0 
3ff'2  ^sf'2 


Sr  = w 5 = -1 
l»Pl  l»Pi 


^ ^1 

Sr  = S r =0 
2,Pj,  2,P^ 


R G 

Sr  S r =0 

3,Pj^ 


R2  C2 

u,  ♦ = 0),  2 =0 

1,P,  1,P, 


“ “2,p,  ” 0 


"2  <=2 

Sr  S r “ ^ 


Thus,  we  can  write  Equations  (96)  through  (99)  as 

^ + C^2‘^2')  (4\  + “3^1  ) 


/ P„  ? \ 

\^13S  '*'  ^13S  / 

\S^p^  " S®p^  j 

(100) 
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i (“h,  ■ “KJ 


- («22“2'  + <=22“?)  “A,  ) 


Sk.  / C-  \ 

^ + ^ll“l ) 


S ^2\ 

^ “ (^23"3  S3"3  ) • 


The  time  derivatives  of  Equations  (102)  and  (103)  are 


i = -'"ii  <=u>“x' 

S ‘Sl.Pj  ° ®2.3  ■<■  <=23>“3^ 

The  substitution  of  Equations  (100),  (101),  (104),  and  (105) 
Equations  (94)  and  (95)  results  in 


F* 


° ■ (®12"2''  <=12“2'')  (“2®Pj  * “3<=Pj) 

(«13“?  <=13“?  ) - Vp,  ) 


+ (Rj^^  + 


F* 


= («2l“? <=2l“?)  (“2<=p,-“l%) 

- (■<22“?  + <=22“?)  (“1<=P,  “^P  j 


- (R23  + C23)  W3 


(101) 

(102) 

(103) 

(104) 

(105) 
into 

(106) 
(107) 
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where  from  Equations  (35),  (36),  and  (37) 


'A 


1 / P P \ 


U) 


2 

p p 

“2  “ “2<=Pj  - 

p p 

“3  '■“3  '“3S/VPj 

c 

• 1 »p 

COi  = 0)^  - 

^2  ^2  P P 


A. 


= (“2%2  • VpJ  ■ 


to 


2 P-  P 

“2  =“2\-V(32 

•^2  *P  y 
0)3  =<«>3  + p2 


so  that  Equations  (106)  aad  (107)  are  finally  written  as 


F*  = 


j ' -<"12  '12’  - “^Pi)(“2\  ■" 

>(4pj  + “^Pl)(“2'Pl  ' “aJ 

(“1  ■ h) 

‘ (■'21  + =21>(“^p,  + - “!=pj 

- '<'>22  <=22)  <\) 

* "22  “(“x%  ■ 

(“3  ^ P2)  • 


+ R^2 


("l3  ^13 


^ ("ll  + Si) 


(108) 


^^3  S3^' 


(109) 
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d.  Active  Forces 


Active  forces  acting  on  the  system  of  rigid  bodies  are 
those  due  to  friction,  gravity,  deformable  wire  drive  (massless)  con- 
nections, spring  tension  due  to  electrical  conductor  connections  between 
moving  parts  and  torque  motors^ 

The  wire  drive  is  asstmed  to  deform  according  to  linear  elasticity. 
The  wire  drive  is  attached  to  the  platform  and  mirror  wheels  in  tension. 
That  is,  there  is  a force  of  in  a wire  segment  vSien  there  is  no 

movement  of  P,  M,  and  B and  ~ ~ wire  can  be  stretched 

or  its  tension  can  be  reduced  by  relative  move’^^nt  of  the  wheels  of  P, 

M,  and  B.  Figure  8 shows  the  configuration  of  the  wheels  and  wire  drive 
with  critical  dimensions,  Free-body  diagrams  of  the  wheels  showing  the 
wire  drive  forces  and  the  relative  rotations  of  the  wheels  are  also 
depicted.  Consider  first  the  wire  of  length  S.  between  the  mirror  and 

platform  v^eels.  The  wire  has  a cross-rectional  area.  A,  and  a modulus 
of  elasticity,  E.  The  increment  in  force  in  this  wire  due  to  the 
relative  rotation  of  P and  M is 

= (EA/S^KrpOp  - r^^e^).  (110) 

Similarly,  the  Increment  in  force  in  the  wire  between  P and  B is 


AFp  = (EA/Sp)(rgeg  - tpOp) 


(111) 


and  the  increment  in  force  in  the  wire  between  M and  B is 


The  moment  of  the  forces  due  to  the  wire  acting  on  M obtained  from 
Equations  (110)  and  (112)  is 

S«w  " % 

= r^  [Kp(rp0p  - r^0j^)  + 


where 


= EA/s 


WIRE  DRIVE 


(a)  COMFIGURATION  OF  THE  WHEELS  AND  WIRE  DRIVE  WITH  DIMENSIONS. 


(b>  WIRE  DRIVE  FORCES  ON  WHEELS  FOR  RELATIVE  ROTATIONS. 

Figure  8.  Wheels  and  wire  drive  configuration,  dimensions,  and  forces. 

Equations  (110)  and  (111)  are  used  to  obtain  the  moment  of  the  forces 
due  to  the  wire  acting  on  P and  give 

Ipw  ■ - '■'o  - Si 

■ 'p‘'^p(’^b‘’b  - - 'p®p>i  Si  (114) 


where 

Kp  = EA/Sp.  Likewise,  from  Equations  (111)  and  (112)  we  obtain 
for  15  under  the  assumption  of  no  slip  between  B and  the  wire 

IbH  = 'b<^0  + '^P  - ■'o  - "n>  Si 
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Coulomb  friction  torque  on  the  mirror  is  written  as 

4c  = -<=H 

For  the  platform  we  have 

- -Cp  sgn  (0p)  (117) 

and  for  the  balancer 

4c  ' 4 

Similarly,  we  denote  viscous  friction  torques  on  M,  P,  and  B by 


(119) 

-PV  ^ "”p  ®P  % 

(120) 

-BV  ^B  ®B  % 

(121) 

For  the  gimbal,  G,  the  Coulomb  effects  are  expressed  as 
^C  “ ^®G^  % 

■+  [C^  sgn  (0j^)  + Cp  sgn  (0p)  - Cg  sgn  (0^)] 
and  those  due  to  viscous  effects  are 
T^V  “ (^q)  £3 

+ (Nm  + ^P  *•  ®B>  % • ^^23) 


(122) 


Gravity  force  torques  are  not  zero  since  there  are  mass  unbalances. 
The  mirror's  gravity  torque  in  the  nip,  m^,  m^  basis  is 

4g  ' ”Vl  " ^ {ls„(s^s^Cj+  C^s^)C^  + 

Ve>4'}  4 . (124) 
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(125) 


Likewise,  the  platform's  gravity  torque  in  terms  of  2.2*  £3 
-PG  ” “p  ^ ® 

■"  *p<^r=a'=e  ■"  Ve>'=g  ■"  "p<“k‘^a^=g'  % 

+ + C|,Sj>s^  - (s„C^)C^lJ  £3 

and  for  the  gimbal,  G,  we  have 

-GG  ~ ""g  " ®R®A®E^  ~ ®3^''G^®R®a‘^E  ''R®E^ 

■"  + S3  [=g<"r"a'=e  ■"  Ve’  - % 

+ gj  [ <SrC^)C^  - + C^Sj)Sj,l  £3!  . (126) 

The  electrical  conductors  which  connect  between  the  gimbal,  G,  and 
the  platform,  P,  exent  a spring  torque  on  the  platform  and  gimbal.  These 
torques  are  expressed  as 


TpS  = -Kj  ®p  Si  (127) 

for  P and 

JgS  = ''s®P%  . (128) 


(1)  Generalized  Active  Forces  for  the  Gimballed  Mirror 
System.  The  generalized  active  forces  for  each  element  of  the  system 
is  determined  by 

^0)  ~ -*e  ' -B  (129) 

B 

where  B denotes  one  of  the  rigid  body  elements  and  T„  is  the  torque 

B 

of  the  moment  about  the  axis  of  rotation  of  all  forces  acting  on  B. 

From  Equation  (14)  we  find 

=0  (130) 

M B P 

iHg  =£3  • (131) 

G 
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Equation  (20)  is  observed  to  give 


(132) 

M. 

-»0„  “ -1 
M 

(133) 

-»0  “ “®a-2  ^a-3  “ % 

G 

(134) 

Similarly,  we  obtain  from  Equation  (21) 

(135) 

- % 

(136) 

= SpEj  + CpEj  = S3 

G 

(137) 

and  from  Equation  (22) 

B.  B.  - 

(138) 

B. 

!^,q  = -% 

O 

(139) 

B 

ii,0  =%  • 

G 

(140) 

Now,  from  Equations  (122), 
obtain 


(123),  (126),  and  (130)  through  (140), 


= -c^  Sgn 


(«g)  -“g  =5"  (®g) 


+ v ?2  K'r'=A>'=G  - + '=r“e>=G> 


t^e 

(141) 


(142) 
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The  contributions  to  the  generalized  forces  by  the  forces  acting  on  M 
are 


VS  C^[  (Sj^C^)Cg  - (Sj^s^C.  + Cj^s^)Sg] 


“ (®m)  ' Vm 

+ [s^(Sj^s^Cg  + Cj^s^)Cg 

®a^®RV®G 


(143) 


(144) 


(145) 


as  seen  from  Equations  (113),  (116),  (119),  (124),  (132),  (133),  and 
(134).  Similarly,  from  Equations  (114),  (117),  (120),  (125),  (135), 
(136),  and  (137),  we  find 


“A 


= 0 


(146) 


- Cp  sgn 


(^)  - 


+ nipPg  f*"p(‘'^R®A®E^  "*  ^P^^rS^ 

'*■  ®P  ^®R®A^E  Ve^S  ’*'  ®P^®R^A^®G^ 

Fq  \ = mpPgCp[  (s^s^Cg  + Cj^Sg)Sg  - 

G/t, 


(147) 

(148) 
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The  contributions  to  the  generalized  forces  by  the  forces  acting  on  3 
are 


= 0 


-rBEKpCrBSj,  - - r^S^,)] 

Cb  sgn  (^b)  - Nb^b  . 


(149) 


(150) 


(2)  Generalized  Active  Forces  for  the  Gyroscopes.  The 
only  forces  acting  on  the  gyroscope  elements  are  those  due  to  friction, 
gravity,  and  the  servo  drive,  gimbal  precession,  torque  motor.  The 
friction  forces  are  described  as  v?.scous  friction.  The  torques  of  their 
moments  for  the  azimuth  and  elevation  gyros  are 


-AV  ~ \ ^1  -11 

(151) 

^2  -23  • 

(152) 

The  gravity  forces  do  not  affect  the  system's  motions  since  the  torques 
about  the  mass  centers  are  zero.  The  gimbal  precession  torque  motors 
of  the  gyroscopes  are  active  only  when  the  platform  is  seirvo  driven  in 
a slewing  or  tracking  mode.  I'/hen  the  precession  torque  motors  are 
active,  they  provide  torques  proportional  to  an  external  rate  signal 
generated  by,  for  example,  a manual  tracking  stick  or  contrast  TV 
tracker.  These  torques  are  not  functions  of  the  generalized  coordinates 
and  can  be  added  in  later. 


To  determine  the  generalized  active  forces  for  the  gyroscope 
systems,  we  refer  to  Equation  (129); 


(153) 


(154) 

(155) 
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wherein 

and 


etc.  are  determined  from  E<(uations  (235),  (236),  and  (237) 
are  given  in  Equations  (151)  and  (152). 


e.  Complete  Nonlinear  Equations  of  Motion 

The  equations  of  motion  of  the  gimballed  mirror  system 
and  the  gyroscope  systems  are  now  obtained  by  simply  setting  to  zero  the 
sum  of  the  generalized  active  forces  for  each  generalized  coordinate 
and  the  corresponding  generalized  inerria  forces;  i.e.,  we  form 


ae 


d Sk 


dt  ^ 


= 0 


(156) 


for  0 replaced  with  each  of  0^^,  0p,  0g,  0^,  and  From  Equations 

(88),  (141),  (145),  (146),  and  (149)  and  the  fact  that 


^0.  = 


we  obtain  for  0. 


M 


r„lKj(rj,ej,  - r„e„)  + - r^,yl 

/„  , 2\  -M  / „ 2\  M M 

- +(m2  - Hj  - »yn  j 0,^ 


m” 


(''g^  + - "2“3K  - (’g^  - '"3"l)v? 

+ - V[V3 

+ («2C„  - I . 


' 3 


®a^3  “ 


+ (m2S^  + m3C^)u)^ 


(157) 
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Similarly,  from  Equations  (89),  (141),  (143),  (147),  and  (149)  we  have 
for  0p 

- Vp»  - <=P  \®p) 

- Vp  * '■  SlS<=R=A=E>  - S<Ve> 


- (Pl  "‘p  P^)“i  + (?2  “ ^3  - > 

- > - p/^yi  - - P/^J 

“ (^3  ^2‘^l)®p“l  ™P  ^[^P^3  “ ®P^G^ 

+ (P^  Cp  + P3  p[spV3  + 


+ (P2  Cp  + ^3  ^ 


^p'^3  S'^G. 


f (P2  Sp  - P3  VC.-J  9p  = 0 . CO. 

Likewise,  from  Equations  (90),  (141),  (143),  (146),  (150),  and  (156), 
we  find  for  0„ 


“ S - Vb'"  h^l  = ^ • 


For  9 we  determine  from  Equations  (91),  (142),  (144),  (148),  (149), 
G 

and  (156)  that 

- Cg  sgn  ^0^,]  - N^0(,  + g g2  - ^®r®aS  ^R®E^  ®G^ 


+ m^  m g Cq[  (Sj^C^)Cg  “ + Cj^Sj,)  s^] 

+ mp  P g Cp[(SpS^Cp  + CpSp)  Sg  - (Sj^C^)  C^] 
- Tg„  + B.  + P.  cJ  + P,  + M„  s^ 


■*■  \ ^2]  “3  [^1  ^^”'2  ■*■ 

“1  “ ^2  ^a  “ “3  4 ■*■  V3  " ®2  "V  ^^2  " ^ 

2 2 1 G G 

+ PjL  “ ?2  ^p  “ ^3  ®p  “2  ^ lother  terras  in  Equation  (91)],  (160) 

The  equation  for  p-  is  obtained  from  Equations  (106),  (153),  and  (154) 
and  is 


- Vi  + <"11  + =11) 


4'  - ('>^2“^  v2%!\  ^ “’hj 

+ (rj3(031  + 0330.3^)  - m^S|3  J = 0. 

From  Equations  (107),  (154),  and  (155)  we  obtain  for  p^  that 

C / R C 

“ ^^2  “ ^^23  ■’■  ^23^  *^3  ■*■  ‘^2l“l")  (“2^2  “ 

- (^22*^2  ■*■  ^22^2  )('^A2  ^ ^^2®p  ) “ ° * 


(161) 


(162) 


3.  Analysis  of  Equations  of  Motion  for  Special  Cases 

The  equations  of  motion  given  in  Equations  (157)  through  (162) 
are  nonlinear  and  quite  complicated  with  various  orders  of  cross-coupling 
terms.  Besides  the  usual  single  rigid  body  cross-coupling  terms,  the 
equations  contain  significant  cross -coupling  terms  due  to  mass  unbalance, 
base  motion,  and  band  drive  deformation.  We  shall  now  put  the  equations 
of  motion  into  a standard  form  of  a system  of  first-order  differential 
equations  suitable  for  numerical  solution  by  a forward  integration 
scheme  such  as  a fourth-order  Runge-Kutta, 

In  the  equations  of  motion,  the  variables  , V_,  V„,  <l>  , , 

"^A’  "^E*  their  derivatives  are  known  functions  of  time  from 

the  dynamics  of  the  base  or  from  measurement  data.  We  must  specify 
initial  conditions  in  solving  the  system  of  differential  equations;  i.e., 
we  must  specify  that  at  time  t = 0,  the  values  0^,  0^,  0^^,  0^^,  9^,  0p, 

^^2'  from  Equation  (14)  we  can  calculate 

the  values  of  w^(0),  ^^(O),  from  Equations  (20),  (21),  and 


A7 


(22)  we  can  calculate  w”(0),  <^i(0)»  ^^(O),  w^CO),  u®(0). 

Following  these  calculations,  we  determine  from  Equations  (36),  (37), 

c c c c c 

(38),  and  (39)  the  initial  values  Wj^^(O),  u)2^(0),  003^(0),  Wj^^(O),  ^^^(O), 

C2  R R R 

(0)  and  from  Equation  (35)  the  Initial  values  (0),  lo^  (0),  (o^  (0) , 

^2 

and  (0) . With  these  initial  conditions  we  solve  the  gyro  Equations 

(161)  and  (162)  and  the  following  set  of  33  first-order  differential 
and  algebraic  equations : 


V„  = 


<=0  ''l  ''2 


= 


S ^^2  - ^1 


10^  = 


• • 

<!>„  + 't'  s 
E R A 


W-  = 


<t>  C C + <li  s 
R A E A E 


bi„  = 


W,  = 


“s/g 


- \‘g)  * \^G  * “s/g 


U)„  = 


CO2  = 

P 

0)2  = 
P 

0).  = 


U)  C - (x)  s 
G 


-®c(“Sj'^G  “s/g)  * "Sj'c  ■ “Sj=G 


Vl  * "p"3 


Cp»5  - =p«2 


1 ^ P P 

^2  = \^2  - \^3 


(163) 

(164) 

(165) 

(166) 

(167) 

(168) 

(169) 

(170) 

(171) 

(172) 

(173) 

(174) 


48 


(175) 

(176) 

(177) 

(178) 

(179) 

(180) 

(181) 
(182'> 

(183) 

(184) 

(185) 

(186) 

(187) 

(188) 

(189) 
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+ ym 
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- C„  0.“  + w“j 

■ "m  ”[V3  + ^a\  * <”>2'=a  - "?] 


■ "m  ” f'a''3  - Vg  <“2=a  ■“3‘='- 


“?]  ®m} 

“1  = (■'i  {(^  - '■3  ■ V^)  "2  “3 

- S (sp)  - »p8p  + rplKpCtjeE  . rpBp) 

+ ™p  P Sf^p^®R®A®E^ 


" *^P^Ve^  ■‘'  ®P^®R®A^^E  ■‘'  Ve^^G 

+ "p'^rV^g'  - "p  •’ 

(''Gj  V2  - Vl 

- f^r 

- P C0?\  C W?  - /v.  + P_(i)^\  s'"  (/ 

\S 

3 LJ  PI 

^3  2 1 J-? 

+ rap  P 

S"3  - =P\,  ■• 

(P2Cp  + P3Sp) 

- rap  P 

>''3  ^ 

(PjSp  - PjCp)  »J] 

(190) 


(191) 


50 


k— 


“l  " {s  (^b)  ♦ Vb 
+ - Vp’  + 'Si<’'b\  - W’} 

“3  = [S  + '3  ••■  ¥p  ■"  ‘'24  + Va  + “24  + "g4 

"b'’2]"^  {h,  ■ ‘=2  ”g4  ”m'”2  ■*■  ’^CC>^ 

T Mj  - M2C^  - + nigb^  + Bj  - B2 

+ «p(P2  - P c/  + Pp  - PpC^p  - Pj^]  U.J  4 

- (4)  ■ ”o4 

■"  "g  s S2‘"r=a‘=g  • ^g^^r^a'^e  '=r'e>1 

"m  S » Cc'^rVg  - "g<=r"aS  * Ve>1 

- mp  g P CptApC^C^  - s^(SpA^Cp  + CpSp)J 


+ [other  similar  terms  from  Equation  (91)]j 


^1  *"l\  / P P 

^12‘^2  ^12^2  j r2°p, 


+ I.03S  - m-C  I lRp3»3l  3-  Cp3«3’- : + N^Bp 


P P. 

1 ^ ’^1 


ij2  = (Rp3  + Cjp)-! 


>'2l“l 


■r  Cppmp^)  (t 


Po  P 

«2Cp^  - 


^2  ^2\  / P P 

- 1 ^22^2  ■*■  ^22^2  / KSo 


)- V: 


(192) 


(193) 


(194) 


(195) 
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These  equations  become  quite  simple  for  the  three  special  cases  of 

a)  Small  vehicle  motion:  ~ ~ ~ ~ 0 

with  their  derivatives 

b)  Small  mass  unbalance:  m ~ P ~ §2  0 

c)  Small  deviations  from  system  looking  forward: 


Q R50  «0  «0  «0  »0 

M M G G B B P 


(J  5S  0 

A E 


R 


^2  ~ ^2 


0 


1 1 

d)  Small  motions  and  mass  unbalances. 


In  Case  a)  the  equations  become: 


V = V 


CO2  = 0 


co^  = 0 


G 

'^a^3 


G 

®P  3 


vl 


^1 

0J2  - w 


52 


“l  “ (''i  V^)’^  {('’2  - ^3  - V^)  “2  “3 

■ S («p)  - Vp 

+ ^p[Kp(rg0g  - rp0p)  + 

- lUp  P g Cp  -f-  mp  P ?2  W3  w^l 

Olf  = B-^  sgn 

+ rj[Kp(rj8j  - TpSp)  + J 

“3  “ {=3  ®3  * ''3'^P  + '’2=P  + «3<=a  + Va  + \4 

+ mj^(m2  + mCQ,)  m2  + rOpCP^  - P Cp)  P2 

+ "b'’2}  {-‘=G  (®g)  - Vg 

+ 2(P3  - Pp.pCpPp  + <P3  - P3)(cJ  - si)  \ 

- ”V”  “2  "a\l  ■ "P  •'  ^2  =P®P  "3  '■'’3  ■ "2>  {4  - 4) 


,2  P 


2 M 


”p  ^ Sp  “3  ®i,  - "Vl  " ®a  “3  * 


M 


Equations  (194)  and  (195)  remain  the  same  in  this  case. 

In  Case  b).  Equations  (163)  through  (189),  (192),  (194),  and  (195) 
remain  the  same,  Pne  other  equations  become 

“1  = «»2  - “3>  “2  “3  - 5l  “S"  % 

- Vm  ■*  V5<'p®p  - W 
■ ""mV'  ) 
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“l  \ |^’’2  ■ ‘’3*  “2  “3  ■ ®sn  •■'p 

- Vp  + 'plKpCrpOp  - rpOp 

Vp)l| 

“3  ‘ [°3  + ®3  + ^2^  + "2=a 
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- <=G  "S"  ’g  ■ Vq 
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- "Cp"?  <V2  + V2  ^ ”p’’2> 

+ {(Pj  - P2)*p‘^p  + (Mp  - M3)ScCjj  + n^mpnij 
+ nipPjP^  + iUpb^bj]  + (mpP^  . nigb^  - ni^tn^) 

•P  2((P3  - P3)SpCpPp  + („3  . H3)s„C^y 
+ UP3  - Pj)  (c^  - + («3  . H^)  (c2  . 3^)  y 


nlinearxtios  like  Coulomb  friction.  Also  added  are  Lrque  terms  which 
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would  result  from  a torque  motor  driving  the  platform 
(I’m  )>  azimuth  gyro  (T^  ),  and  elevation  gyro  (T_  ). 


G 

obtain 


m. 


ra. 


Ui  1 


V = V 

2 


E 


"3 

G 

coi  = (0 


•G 

“l  = ‘"s. 


G 

0)2  = 0)g^ 


• G 

0)^  = 0)„ 
2 S 


2 


0)2  ==  0)2 


P _ G 
“3  ^3 


M - G G 

‘*’2  “ o^‘'^2  ” ®a"3 


M _ G 4.  ^ G 

“3  ®a  2 ^a'^3 


^1  P 

0)2  = 0)2 


^1  P 

0)3  =0)3 

Rp 

0)2  =0)2  - 0) 


(Tm  ),  gimbal 
P 

In  this  case  we 
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^1  _ ^1 
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“? = 

“1^ = 

^2  _ <^2 
^2  ^ 


« - M G 

«M  - "1  - "1 


G 3 S, 

(9  - ,,P  G 

e?  - U)i  - co^ 


a - G B 

^ - “1  - “1 

• P ^1 

^x  = "1  - "1 


= U, 


'2  P 

- «„ 


“1  “ (“1  + V^)'^  |-c„ 


2 3 ”3 

V I i-c„  sgn  . N^e,, 
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2^  " ™3®a^ 


+ "Vl  "1  8 C^  - n^j  + (m 
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+ ^ptKp(rg0g  - rp0p)  + K^(r^0j^  - r^Op)] 

(V3  4-  P^,:,^^  4-  T^l 


“ nip  g p + nip  P 
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"’i  = h f B Vb 

'Si^’^b'^b  - ’^hV'I 
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+ (M2  - ^3)^^  + *** 

+ mpP3(P2  - P)  + mgb2b3j  - Im^g^ 

- mp(P2  - P)  + mgb2  + + mC^)] 


“1  = (^11  "11) 


•1  r • p/  h ^i\ 

Vl  + "3\fl2"2  "i2"27  - \ 

-1  • p/  ^2  ^2\ 

' ["£^2  ‘^ll^22“2  ■*■  Vl  ) - \ 


s' ' -<S3  + S3>''  ss  + “ 


If  we  assume  that  the  mass  unbalance  of  M and  P are  negligible  and 
all  motions  are  small,  we  have  Case  d).  In  this  case  the  equations  of 
motion  are: 


s + s 


’i(s  s) 


) + Vm 


+ S 'S"  S + Si<s 


r„‘pVp  - VbVb  “ ° 


(196) 


+ Np6p  + Cp  sgn  6p  + rp(K^  + Kp)0p 


- "p"m^i®m  - ^p’^b'^p^b  = V 


(197) 


h{%  - Vb  S "sn  % + 4 V *^^B 


'B^P^P^P  ■ *^b^mVm  “ ® 


+ \) 


(Rj^  + 


Vc  * % "8-  »c  - \[V2S3 

(“2  ■ "V"2"3  ”p’’2'3  "b*’2''3] 

'1' V2  - V2  + ”b‘‘2  + "Vf2i  “ V 

G 

- - ‘e)  ^ Vi  - “'<12(^0  + \)  “ \<v 


(200) 


(R 


23 


^23^' 


(^2  "g  ^) 


V2 


(201) 

These  linearized  equations  for  a perfectly  balanced  system  are 
normally  used  in  the  design  of  control  compensators  for  system. 
Equations  (196)  through  (201)  are  put  in  state  variable  form  in  a block 
diagram  in  Section  4, 


4.  State  Variable  Block  Diagram 

A block  diagram  of  Equations  (196)  through  (201)  for  Case  d), 
suitable  for  programming  an  analog  computer,  is  presented  in  Figure  9, 

Tlie  output  of  each  integrator  is  a state  variable.  Figure  9 is  shown 
for  a closed-loop  system;  i.e.,  it  not  only  shows  the  gimbal  d}mamics 
and  the  gyro  sensor's  d}mamics  but  includes  blocks  representing  torque 
generators  (motors)  for  driving  the  gimbals  and  blocks  for  compensators 
to  give  the  desired  closed-loop  response.  The  details  of  the  torque 
generator  blocks  and  compensator  blocks  are  not  shown  since  they  have 
been  adequately  defined  in  References  1 and  2,  or  they  are  to  be 
designed.  It  should  be  noticed  in  the  block  diagram  that  the  gyro  blocks 
could  be  simplified  by  reducing  their  orders,  i.e.,  the  number  of 
integrators.  This  is  equivalent  to  pole-zero  cancellation  and  can  cause 
a reduction  in  system  analysis  information. 


5.  Conclusions 

The  full  nonlinear  equations  of  motion  can  be  used  to  analyze 
the  system  for  both  large  and  small  base  motion  inputs  and  for  large 
platform  motions  such  as  occur  in  tracking  or  acquisition.  However, 
only  the  inner  loop  or  stabilization  loop  has  been  considered  in  the 
derivation. 
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Figure  9*  State  variable  block  diagram 


Linearized  equations  are  valid  for  large  angles  of  pointing  from 
the  forward-pointing  orientation  if  angular  rates  are  small  and  one 
linearizes  about  the  new,  large  angles. 

All  forces  acting  on  the  system  have  been  expressed  in  terms  of 
the  states  of  the  system  by  carefully  considering  such  affects  as 
prestress  in  the  wire  drive,  precise  geometry  and  stretch  of  the  wires. 
Coulomb  and  viscous  friction,  mass  unbalance  torques  due  to  gravity 
and  accelerations,  and  torques  produced  by  the  electrical  wiring.  From 
observations  of  the  movement  of  the  system  in  the  laboratory  it  was 
found  that  Coulomb  friction  and  electrical  wiring  (flex  lead)  torques 
were  greater  than  those  due  to  mass  unbalance. 
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SYMBOLS 


S,  G,  M,  P,  B 
^G 

S G M P B 


> 

^ > 

U : 

% 

£2> 

% 

S2> 

S3 

S-2’ 

^3 

^1* 

-2’ 

^3 

% 

Sq, 

g\ 

* 

P , 

* 

M 

£o>  B.,  a,  ^ 

M*  P*  B* 
V , V , V 


oK  $K 


K,0JJ  ; K,0g  ; K,0p  ; K,6^ 


Characterizing  the  Base,  Gimbal,  Mirror, 
Platform,  and  Balancer 

Independent  azimuth,  elevation,  and  roll 
angles 

Angle  of  rotation  of  the  gimbal,  G,  with 
respect  to  the  Base,  S 

Angle  of  rotation  of  the  platform,  P,  with 
respect  to  the  gimbal,  G 

Angle  of  rotation  of  the  mirror,  M,  with 
respect  to  the  gimbal,  G 

Angle  of  rotation  of  the  balancer,  B,  with 
respect  to  the  gimbal,  G 

Inertial  angular  velocities  of  S,  G,  M,  P, 
and  B 

Base  vectors  fixed  in  S 

Base  vectors  fixed  in  the  platform,  P 

Base  vectors  fixed  in  the  mirror,  M 

Base  vectors  fixed  in  the  gimbal,  G 

Base  vectors  fixed  in  the  balancer,  B 

Point  in  S and  G for  which  motion  is 
prescribed  about 

Cencers  of  rotation  of  P,  M,  and  B 
Distance  vector  from  Gq  to  Pp,  and  Bp 

Centers  of  mass  of  G,  P,  M,  and  B 

Position  vector  o:  center  of  mass  from 
center  of  rotation 

Velocity  of  centers  of  mass  of  M,  P,  B in 
the  inertial  frame 

Partial  derivatives  of  the  total  kinetic 
energy  with  respect  to  the  generalized 
coordinates  9 , 9 , 9 

Partial  derivatives  of  tbs  total  system 
kinetic  energy  with  respect  to  the  derivatives 
of  the  generalized  coordinates 
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Generalized  inertia  forces  for  M,  P,  B,  and  G 


Generalized  inertia  forces  for  the  gyroscopes 


T 


’ -IW  ’ -BW 


Moments  of  the  forces  due  to  the  wire  band 
drives  acting  on  M,  P,  and  B 


T 

■%C 


T 

’ -PC 


T 

’ "BC 


T 

’ -^C 


Coulomb  friction  torque  acting  on  M,  P,  B, 
and  G 


T T T T 
’ -PV  ’ -BV  ’ 


Viscous  friction  torques  acting  on  M,  P, 
B,  and  G 


TXT 
■%G  ’ -PG  ’ -^G 


Torques  acting  on  M,  P,  and  G due  to  mass 
unbalance 


T T 
-PS  ’ -^s 


Spring  torque  forces  acting  on  P and  G 
due  to  electrical  conductors 
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